Development  of  a  ground  test  concept  based  on  multi-rotors 
for  in-flight  RVD  experimentation 


ELISA  CAPELLO 
GIORGIO  GUGLIERI 

POLITECNICO  DI  TORINO 

Dipartimento  di  Ingegneria  Meccanica  ed  Aerospaziale  (DIMEAS) 

Corso  Duca  degli  Abruzzi  24 
Torino,  10129  ITALY 


EOARD  Grant  #FA23 86- 14- 1-5007 
Report  Date:  August  2015 

Final  Report  from  30  September  2014  to  31  August  2015 


Distribution  Statement  A:  Approved  for  public  release  distribution  is  unlimited. 


Air  Force  Research  Laboratory 
Air  Force  Office  of  Scientific  Research 
European  Office  of  Aerospace  Research  and  Development 
Unit  4515,  APO  AE  09421-4515 


REPORT  DOCUMENTATION  PAGE 

Form  Approved  0MB  No.  0704-0188 

Public  reporting  burden  for  this  collection  of  information  is  estimated  to  average  1  hour  per  response,  including  the  time  for  reviewing  instructions,  searching  existing  data  sources,  gathering  and 
maintaining  the  data  needed,  and  completing  and  reviewing  the  collection  of  information.  Send  comments  regarding  this  burden  estimate  or  any  other  aspect  of  this  collection  of  information, 
including  suggestions  for  reducing  the  burden,  to  Department  of  Defense,  Washington  Headquarters  Services,  Directorate  for  Information  Operations  and  Reports  (0704-0188),  1215  Jefferson 
Davis  Highway,  Suite  1204,  Arlington,  VA  22202-4302.  Respondents  should  be  aware  that  notwithstanding  any  other  provision  of  law,  no  person  shall  be  subject  to  any  penalty  for  failing  to  comply 
with  a  collection  of  information  if  it  does  not  display  a  currently  valid  0MB  control  number. 

PLEASE  DO  NOT  RETURN  YOUR  FORM  TO  THE  ABOVE  ADDRESS. 

1.  REPORT  DATE  ^DD-MM-yyyV9  2.  REPORT  TYPE 

22  August  2015  Final  Report 

3.  DATES  COVERED  (^From  -  To) 

30  September  2014 -31  August  2015 

4.  TITLE  AND  SUBTITLE 

Development  of  a  ground  test  concept  based  on  multi-rotors  for  in¬ 
flight  RVD  experimentation 

5a.  CONTRACT  NUMBER 

5b.  GRANT  NUMBER 

FA2386-14-1-5007 

5c.  PROGRAM  ELEMENT  NUMBER 

61102F 

6.  AUTHOR(S) 

ELISA  CAPELLO 

GIORGIO  GUGLIERI 

5d.  PROJECT  NUMBER 

5d.  TASK  NUMBER 

5e.  WORK  UNIT  NUMBER 

7.  PERFORMING  ORGANIZATION  NAME(S)  AND  ADDRESS(ES) 

POLITECNICO  Dl  TORINO 

Dipartimento  di  Ingegneria  Meccanica  ed  Aerospaziale  (DIMEAS) 

Corso  Duca  degli  Abruzzi  24 

Torino,  10129  ITALY 

8.  PERFORMING  ORGANIZATION 

REPORT  NUMBER 

N/A 

9.  SPONSORING/MONITORING  AGENCY  NAME(S)  AND  ADDRESS(ES) 

EOARD 

Unit  4515 

APO  AE  09421-4515 

10.  SPONSOR/MONITOR’S  ACRONYM(S) 

AFRL/AFOSR/lOE  (EOARD) 

11.  SPONSOR/MONITOR’S  REPORT  NUMBER(S) 

AFRL-AFOSR-UK-TR-201 5-0043 

12.  DISTRIBUTION/AVAILABILITY  STATEMENT 

Distribution  A:  Approved  for  public  release;  distribution  is  unlimited. 

13.  SUPPLEMENTARY  NOTES 

14.  ABSTRACT 

The  objective  of  this  research  is  a  feasibility  study  of  an  LI -based  GNC  for  rendez-vous  and  docking  maneuvers  of  two 
systems,  including  theoretical  background  and  a  comprehensive  analysis  of  simulation  results. The  performance  of  the 
proposed  GNC  design  will  be  evaluated  in  a  simulation  environment  reproducing  the  dynamics  of  a  multi-rotor  micro-aerial 
vehicle.  The  nonlinear  and  linear  models  of  an  hexarotor  Unmanned  Aerial  Vehicle  (UAV)  are  identified  using  a  VICON  system. 

Some  simulations  are  performed  to  validate  the  implementation  of  the  nonlinear  model  in  the  Matlab-Simulink  environment. 

Two  controllers  have  been  implemented:  (i)  a  classical  linear  quadratic  regulator  (LQR)  and  (ii)  an  LI  adaptive  controller.  Both 
controller  performance  are  validated  by  simulations.  Different  cases  are  analyzed,  including  simulations  of  experimental  flights. 

The  LI  adaptive  controller  is  validated  not  only  for  the  linear  model  but  also  for  the  nonlinear  model  and  for  "realistic"  cases  in 
which  a  time  dealy  and  an  actuator  model  are  included.  Both  controllers  guarantee  good  performance.  A  retuning  of  the  LI 
controller  is  not  required  even  in  presence  of  time  delay  and  for  the  nonlinear  model. 

15.  SUBJECT  TERMS 

EOARD,  multirotor  UAVs,  identification,  simulation  methods,  experimental  results,  rendez-vous  and  docking 

16.  SECURITY  CLASSIFICATION  OF: 

17.  LIMITATION  OF 
ABSTRACT 

18,  NUMBER 
OF  PAGES 

19a.  NAME  OF  RESPONSIBLE  PERSON 

Kent  Miller 

a.  REPORT 

UNCLAS 

b.  ABSTRACT 

UNCLAS 

c.  THIS  PAGE 

UNCLAS 

SAR 

42 

19b.  TELEPHONE  NUMBER  (Include  area  code) 

+44  (0)1895  616816 

standard  Form  298  (Rev.  8/98) 
Prescribed  by  ANSI  Std.  Z39-18 


Technical  Report 

“Development  of  a  ground  test  concept 
based  on  multi-rotors  for  in-flight  RVD 
experimentation” 

DEMO  Project  -  EOARD  Grant 
FA2386-14-1-5007 

Period  of  performance:  January-July  2015 


Investigator:  Prof.  Giorgio  Guglieri 
Co-Investigator:  Dr.  Elisa  Capello 

Politecnico  di  Torino,  Dipartimento  di  Ingegneria  Meccanica  ed 
Aerospaziale  (DIMEAS),  Corso  Duca  degli  Abruzzi  24,  10129  Torino, 
Italy;  e-mail: (giorgio. guglieri,  elisa.eapello)@polito.it. 


Abstract:  The  objective  of  this  research  (EOARD  Grant  14  —  5007)  is  a  feasibility  study  of 
an  £i-based  GNC  for  rendez-vous  and  docking  maneuvers  of  two  systems,  including  theoretical 
background  and  a  comprehensive  analysis  of  simulation  results.  The  performance  of  the  proposed 
GNG  design  will  be  evaluated  in  a  simulation  environment  reproducing  the  dynamics  of  a 
multi-rotor  micro- aerial  vehicle.  The  nonlinear  and  linear  models  of  an  hexarotor  Unmanned 
Aerial  Vehicle  (UAV)  are  identified  using  a  VIGON  system.  Some  simulations  are  performed 
to  validate  the  implementation  of  the  nonlinear  model  in  the  Matlab-Simulink  environment. 
Two  controllers  have  been  implemented:  (i)  a  classical  linear  quadratic  regulator  (LQR)  and  (ii) 
an  Cl  adaptive  controller.  Both  controller  performance  are  validated  by  simulations.  Different 
cases  are  analyzed,  including  simulations  of  experimental  flights.  The  Ci  adaptive  controller  is 
validated  not  only  for  the  linear  model  but  also  for  the  nonlinear  model  and  for  ’’realistic”  cases 
in  which  a  time  dealy  and  an  actuator  model  are  included.  Both  controllers  guarantee  good 
performance.  A  retuning  of  the  Ci  controller  is  not  required  even  in  presence  of  time  delay  and 
for  the  nonlinear  model. 

Keywords:  multirotor  UAVs,  identification,  simulation  methods,  experimental  results, 
rendez-vous  and  docking 


Distribution  A;  Approved  for  public  release;  distribution  is  unlimited. 


Contents 


1  Introduction  3 

2  Model  description  4 

2.1  Hexacopter  model  4 

2.2  VICON  system  5 

3  Identification  of  the  Hexacopter  5 

3.1  Identification  of  Moments  of  Inertia  6 

3.2  Engine  Identification  9 

4  Nonlinear  and  linear  models  16 

5  Cl  Adaptive  Controller  18 

6  Linear  Quadratic  Regulator  20 

7  Simulation  and  experimental  results  21 

8  Correlations  of  simulations  and  real  flight  conditions  36 

9  Conclusions  36 

10  Note:  Differences  between  the  developed  and  the  original  project  38 

Acknowledgements  38 


2 


Distribution  A:  Approved  for  public  release;  distribution  is  unlimited. 


1  INTRODUCTION 


1.  INTRODUCTION 


The  rendez-vous  and  docking  (RVD)  maneuver  is  a  key  operational  technology  that  is  required  for  many  missions, 
and  it  consists  of  a  series  of  orbital  maneuvers  and  controlled  trajectories,  where  an  active  spacecraft  (Chaser)  tries  to 
capture  a  passive  Target  vehicle  or  to  reach  and  remove  large  space  debris  object.  Usually,  the  goal  of  the  RVD  mission 
is  that  a  Chaser  vehicle  has  to  safely  and  efficiently  approach  the  Target  vehicle  (that  is  in  a  fixed  position)  to  within 
a  few  centimeters  (surface-to-surface)  and  remain  stationary  there  until  the  hold  mechanism  captures  and  docks  the 
target  vehicle. 

Traditionally,  rendez-vous  and  proximity  maneuvers  have  been  performed  using  open  loop  maneuver  planning  techniques 
and  ad  hoc  error  corrections.  Various  constraints  arises  in  these  maneuvers  including  constraints  on  thrust  magnitude, 
on  platform  positioning  within  Line-of-Sight  cone  while  approaching  the  docking  system  on  a  target  platform  and  on 
approach  velocity  to  match  the  velocity  of  the  docking  port.  As  pointed  out  in  [31,  25]  one  reason  for  considering 
adaptive  methods  in  these  practical  applications  is  to  compensate  for  large  variations  in  plant  parameter  values.  For 
this  reason,  in  this  research  an  jCi  adaptive  controller  is  proposed,  that  is  robust  even  when  parameters  have  a  high  rate 
of  variation  [5].  First,  this  controller  ensures  uniform  transient  tracking  for  both  the  system  inputs  and  outputs.  Second, 
the  adaptation  sampling  time  associated  with  the  sampling  rate  of  the  autonomous  system  [7,  8].  The  robustness  of 
this  controller  is  compared  with  a  classical  robust  control. 

The  purpose  of  this  research  activity  is  an  exploratory  study  that  may  provide  evidence  of  the  feasibility  of  the  Ci 
adaptive  controller  for  docking  maneuvers.  One  problem  for  the  implementation  of  this  algorithm  on  a  mockup  or  on 
a  real  spacecraft  is  the  cost  of  the  platform  and  of  the  spacecraft  systems.  The  idea  of  this  model-based  research  is 
to  reduce  development  time  and  cost  by  eliminating  the  need  for  early  product  prototypes  and  by  narrowing  down 
possible  design  alternatives  early  in  the  process  [33,  16].  In  a  competitive  market,  actors  in  technology  and  engineering 
industries  seek  to  reduce  cost  and  time  consumption  for  their  development  processes.  For  this  reason,  we  propose  to 
implement  and  validate  the  adaptive  controller  on  a  multi-rotor  Unmanned  Aerial  Vehicle  (UAV)  that  has  to  dock  on 
a  fixed  target. 

In  recent  years,  researchers  have  begun  to  integrate  adaptation  in  the  control  designs  of  multirotor  UAVs  in  order  to 
achieve  a  higher  accuracy  and  robustness  in  presence  of  model  uncertainties  and  external  disturbances.  In  [35]  a  review  of 
several  algorithms  have  been  analyzed  including  their  advantages  and  disadvantages,  considering  multi-rotor  nonlinear 
nature  and  under-actuated  configuration.  Roberts  et.al.  [28]  proposed  an  adaptive  controller  for  the  position  tracking 
of  a  vertical  take-off  and  landing  UAV.  The  validation  of  the  controller  is  limited  to  bounded  inputs  and  outputs,  and 
it  is  not  applied  to  a  nonlinear  model. 

Our  research  proposes  a  model-based  design  of  a  multi-rotor  UAV,  starting  from  the  identification  of  the  model 
parameters  and  to  use  the  UAV  prototype  for  technology  demonstration.  The  purpose  of  this  research  also  includes 
exploration  of  position  estimation  techniques  using  a  VIC  ON  system. 

Model-based  control  systems  design  is  a  concept  where  mathematical  process  models  are  used  to  simulate  and 
verify  system  performance  before  building  physical  prototypes.  Model-based  software  design  simplifies  conventional 
development  using  an  intuitive  block  diagram  environment  and  automatic  code  generation.  Model-based  development 
with  code  generation  is  claimed  to  be  a  promising  approach  when  developing  image  analysis  algorithms  towards 
embedded  platforms  [10].  MathWorks  recently  added  native  support  for  code  generation  in  Simulink  for  small  singleboard 
computers  powerful  enough  to  perform  advanced  image  analysis  algorithms.  These  platforms  are  available  at  consumer 
price  levels  and  no  extra  code  generating  Matlab  toolboxes  are  required. 

The  model-based  design  approach  using  a  plant  model,  achieved  through  physical  modeling  and  system  identification, 
enabled  early  verification  and  validation  of  control  and  image  analysis  algorithms.  Identification  of  different  parameters 
is  a  time  consuming  and  in  many  cases  expensive  processes.  Works  of  [13]  show  that  even  though  it  is  possible,  it 
demands  a  lot  of  equipment  and  multiple  experiments.  The  parameters  are  validated  only  for  hovering,  since  recreating 
the  condition  during  forward  flight  is  very  difficult.  One  approach  that  could  prove  useful  is  the  one  used  in  [1,  2].  The 
authors  try  to  identify  linear  decoupled  models  with  data  collected  from  flight  experiments.  The  problem  of  this  kind 
of  identification  is  that  to  perform  flight  experiments  a  working  feedback  controller  is  needed  on-board. 

Our  idea  is  to  select  an  open  loop  identification  method  of  the  multi-rotor  physical  parameters.  The  novelty  of  the 
proposed  approach  id  that  a  VIC  ON  system  is  considered  for  identify  the  system  and  for  the  evaluation  of  the  thrust 
and  torque.  This  approach  is  chosen  to  reduce  the  time  of  collecting  data  and  to  avoid  risk  of  accidents  during  flight 
tests  considering  that  a  controller  is  not  yet  implemented  on-board.  The  nonlinear  model,  implemented  in  Matlab- 
Simulink,  is  validated  with  experimental  flights  of  an  hexacopter  UAV.  A  linear  quadratic  regulator  and  an  Ci  adaptive 
controllers  are  also  implemented  considering  the  identified  physical  parameters.  The  performance  of  both  controllers 
are  evaluated  by  a  comprehensive  analysis  of  simulation  results.  Different  cases  are  analyzed.  The  robustness  of  the 
jCi  adaptive  controller  is  validated  with  the  application  to  a  nonlinear  model  that  includes  a  time  delay  on  the  control 
channel  and  an  actuator  model. 
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2  MODEL  DESCRIPTION 


2.  MODEL  DESCRIPTION 

The  problem  of  identification  proposed  in  this  paper  is  applied  to  a  multi  rotor  UAV  with  six  engines  using  a  VIC  ON 
system  for  the  measurement  of  inertia  and  thrust /torque  gains. 

2. 1  Hexacopter  model 

We  assume  that  the  hexacopter  structure  is  rigid  and  that  the  center  of  mass  (CoM)  is  coincident  with  the  geometrical 
center  (GC).  The  hexacopter  consists  of  six  arms  all  connected  symmetrically  to  the  central  hub  to  simplify  the  balance 
of  the  separate  thrusters.  Kevlar  bars  are  considered  for  the  structure  construction.  At  the  end  of  each  arm  a  propeller 
driven  by  an  electric  motor  is  attached.  See  Eigure  1  for  the  hexarotor  system.  The  hub  has  to  be  designed  to  ensure 
the  correct  location  and  orientation  of  the  struts  on  assembly  and  could  be  a  simple  under-over  clamping  system  to 
provide  a  rugged  demountable  part.  All  the  propellers  have  fixed  pitch  blades,  thus  the  propellers  can  not  be  tilted.  As 
indicated  in  Eig.  2,  three  propellers  rotate  anticlockwise  and  three  clockwise. 


Eig.  2.  Hexacopter  rotations  and  body  reference  frame.  A  =  Anticlockwise,  C  =  Clockwise.  {Xb^Yb^Zb)  is  the  body 
reference  frame. 

Eour  basic  movements  are  considered  varying  the  thrust  produced  by  each  propellers.  The  rotation  of  the  rotors  produce 
also  a  reaction  torque,  opposite  of  the  rotation  direction.  Since  half  of  the  propellers  are  spinning  in  one  direction,  the 
net  torque  when  all  rotors  have  equal  speed  is  zero. 

The  main  control  of  the  hexacopter  is  the  throttle  and  it  is  used  for  the  movements  in  the  body  vertical  direction.  Since 
the  propellers  are  fixed  pitched,  the  direction  of  the  throttle  is  fixed  and  it  is  used  to  counter  act  the  gravity.  When 
increasing  (decreasing)  the  throttle,  the  hexarotor  will  travel  upwards  (downwards).  Throttle  is  produced  by  increasing 
(decreasing)  the  speed  of  all  rotors  of  the  same  entity. 

The  second  basic  movement  is  related  to  the  roll  variation,  that  is  produced  by  increasing  (decreasing)  the  speed  of 
rotors  on  right  side  while  decreasing  (increasing)  the  left  side  rotor  speed  of  the  same  amount. 

The  third  movement  is  the  pitch  variation,  that  is  produced  by  increasing  (decreasing)  the  rear  rotor  speed  while 
decreasing  (increasing)  the  front  rotor  speed. 

The  yaw  movement  (fourth  basic  movement)  is  produced  by  increasing  (decreasing)  the  speed  of  the  rotors  rotating 
clockwise  while  decreasing  (increasing)  the  rotors  rotating  anticlockwise. 

The  electric  engines  are  the  T-Motor  KV  750  (MT2212)  with  E-prop  ultra-light  carbon  propellers.  A  radio  controller 
is  used  to  control  the  hexarotor  by  sending  reference  values  for  controls. 
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2.2  VICON  system 


3  IDENTIFICATION  OF  THE  HEXACOPTER 


The  hexacopter  is  able  to  perform  autonomous  flight  thanks  to  the  on  board  installation  of  an  autopilot,  that  is  the 
PixHawk,  that  is  a  high-performance  autopilot-on-module.  Its  main  characteristics  comprehend  an  open  architecture, 
the  possibility  to  be  reprogrammed  in  flight  and  real  time  telemetry.  The  CPU  is  the  32bit  STM32F427  Cortex  M4 
core  with  FPU  and  2Mb  flash  memory  and  256  kb  of  RAM  with  a  CPU  clock  of  168  MHz.  The  autopilot  is  placed  on 
the  central  hub  together  with  the  Lithium  Polymer  (LiPo)  battery  and  the  receiver  connected  to  the  ground  control 
station. 

The  characteristics  of  the  hexacopter  are  in  Table  1.  The  approximate  total  weight  of  the  multi  rotor  is  930  gr. 

Table  1.  Hexacopter  Characteristics 


Electric  motor 

T-Motor  KV  750  (MT2212) 

me  =  55  g 

Propeller  E-Prop 

254  mm  x  120  mm 

rup  =  12  g 

LiPo  Battery 

Thunder  Power  ISOOmAh 

mb  =  155  g 

Structure  weight 

rus  =  350  g 

Total  weight 

m  =  930  g 

2.2  VICON  system 


For  the  identification  of  the  inertial  and  propulsion  characteristics,  a  VICON  system  is  used.  The  VICON  motion  capture 
system  is  a  state-of-the-art  infrared  marker-tracking  system  that  offers  millimeter  resolution  of  3D  spatial  displacements. 
Ten  VICON  cameras  (see  Fig.  3)  are  installed  along  the  walls  of  the  laboratory  to  collect  and  stream  high  quality  3D 
position  and  attitude  information.  The  VICON  server  is  able  to  provide  the  position  and  the  attitude  of  a  rigid  body 
with  a  resolution  between  0.001  and  0.01  millimeters.  The  refresh  rate  is  limited  only  by  the  streaming  rate  of  the 
TCP/IP  network,  while  the  resolution  depends  on  the  distance  and  number  of  passive  markers  on  the  tracked  body. 


Fig.  3.  VICON  system  at  NPS  laboratory 

3.  IDENTIFICATION  OF  THE  HEXACOPTER 

The  identification  of  multirotors  systems  is  usually  carried  out  with  two  different  approaches.  One  is  based  on  the 
identification  of  physical  parameters  and  the  second  is  based  on  the  variation  of  contol  inputs  and  is  called  direct 
approach.  Both  ways  are  model  -  dipendent  approaches,  even  if  once  performed  on  one  system  it  can  easily  be  repeated 
on  other  systems.  The  most  tested  approach  is  the  idenification  of  physical  parameters,  such  as  moments  of  inertia  and 
the  relation  between  propeller  thrust /torque  and  propeller  angular  speed.  This  approach  was  tried  by  [3,  29].  The  other 
approach  is  the  black  box  identification  between  the  virtual  control  input  and  the  angular  rate.  The  second  approach  was 
tried  by  [2,  23].  The  drawback  of  this  second  approach  is  that  to  perform  the  flight  experiments  to  acquire  identification 
data,  the  multirotor  has  to  have  a  working  controller,  this  means  that  the  input  signal  will  not  be  the  one  actually 
controlling  the  multirotor,  but  a  reference  signal  to  the  control  system  or  an  overlay  on  the  controller  output. 

Eor  the  implementation  of  the  selected  controller  an  open  loop  identification  method  is  chosen,  that  is  identification  of 
physical  parameters.  The  novelty  of  the  proposed  approach  is  the  use  of  VICON  system  for  measuring  the  moments  of 
inertia  and  for  evaluating  the  static  gains  of  the  engine  (both  thrust  and  torque  gains).  The  second  approach  is  chosen 
for  reducing  the  time  of  collecting  data  and  to  avoid  the  risk  of  accidents  during  flight  tests,  considering  that  a  stable 
and  robust  controller  is  not  yet  implemented  on-board. 

Note  that  for  the  controller  chosen  for  this  research  (an  Ci  adaptive  contoller)  we  have  to  evaluate  a  state  predictor 
dynamics  (see  Section  5),  thus  the  nominal  linear  model  of  the  system  should  be  known  to  obtain  better  performance 
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3. 1  Identification  of  Moments  of  Inertia 


3  IDENTIFICATION  OF  THE  HEXACOPTER 


during  flight  tests  and  when  uncertainties  (i.e.  variations  of  the  flight  conditions,  of  the  system  and  payload  masses, 
etc.)  occur  on  the  system. 

3.1  Identification  of  Moments  of  Inertia 

For  the  evaluation  of  the  moments  of  inertia  of  a  body  usually  masses  and  spatial  distributions  of  the  components  are 
measured.  All  the  distances  have  to  be  measured  and  all  the  components  have  to  be  weighted.  One  problem  of  the 
geometric  evaluation  of  the  moments  of  inertia  is  that  the  body  has  to  be  assembled  or  disassembed  in  the  laboratory. 
If  a  commercial  multirotor  is  considered  (as  in  our  case),  disassembling  the  overall  system  should  be  time  consuming. 

In  our  case  the  idea  is  to  use  the  rules  of  compound  pendulum  [27]  for  evaluating  the  moments  of  inertia  of  the  body. 
It  is  also  a  prototypical  system  for  demonstrating  the  Lagrangian  and  Hamiltonian  approaches  to  dynamics  and  the 
machinery  of  nonlinear  dynamics. 

We  assume  that  the  moments  of  inertia  along  the  Xb  axis  is  equal  to  the  moments  of  inertia  of  the  Yb  axis,  considering 
the  mass  distribution  of  the  hexacopter. 

The  equations  of  motion  are  derived  by  Lagrangian  dynamics 

C  =  K -V 

where  K  is  the  kinetic  energy  and  V  is  the  potential  energy  of  the  pendulum.  We  assume  that  the  total  energy  at  the 
zero  time  E(to)  is  equal  to  the  maximum  potential  energy  V{to)  and  that  the  kinetic  energy  is  zero.  At  the  time  to  we 
have 


E{tfj  =  -V{to)  =  -mg  cos  Ooh 
K{to)  =  0 

where  m  is  the  total  mass  of  the  hexacopter,  is  the  zero  inclination  angle  (when  the  potential  energy  is  maximum), 
li  is  the  arm  of  the  pendulum  with  respect  to  the  pendulum  CoG  (distance  between  the  yellow  bar  and  the  red  point  in 
Figure  4).  The  mass  and  geometry  of  the  system  are  known.  The  variation  of  the  angle  0  (inclination  of  the  pendulum, 
see  Figure  4)  is  known  at  each  time  step  and  evaluated  with  the  VIC  ON  system. 


(yaw) 


Fig.  4.  Compound  pendulum  setup  for  the  evaluation  of  the  yaw  moments  of  inertia 
In  the  analyzed  case,  we  have 


V  =  —mg  cos  011  (1) 

K  =  +  ll0^  (2) 

where  9  is  the  pendulum  inclination  angle  measured  by  VICON,  I  is  the  moment  of  inertia  (unknown),  9  =  ^  is 
the  variation  of  the  inclination  angle  with  respect  to  time  (measured  by  VICON).  As  in  Eq.  2  for  the  pendulum  rules 
the  kinetic  energy  is  sum  of  a  linear  and  a  rotational  component.  The  unknown  moments  of  inertia  that  are  directly 
evaluated  with  VICON  system  and  with  the  pendulum  theory  are  the  moments  around  the  Zb  (left  of  Figure  5)  and 
Yb  (right  of  Figure  5)  axes.  As  in  Fig.  5  the  setup  of  the  experiments  is  the  following: 

•  a  rigid  rod  is  connected  to  the  hexacopter  by  a  system  of  screws  and  nuts, 

•  the  same  rod  is  connected  to  a  structure  with  a  base  on  ground. 
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Fig.  5.  Pendulum  experimental  setup  for  the  evaluation  of  the  yaw  moments  of  inertia  (left)  and  of  the  pitch  moments 
of  inertia  (right) 

An  hexacopter  object  is  created  on  VICON.  Usually  the  zero  position  of  the  object  should  be  setted  when  the  platform 
is  on  the  ground  but,  in  the  analyzed  case,  the  zero  angles  are  evaluated  when  the  hexacopter  is  in  the  zero  pendulum 
position  (Fig.  7). 

Four  experiments  are  performed  for  each  axes.  For  both  moments  of  inertia  the  reference  axis  for  the  VICON  measures 
is  the  X  one,  due  to  the  acquisition  of  the  zero  positions.  This  means  that  the  variations  of  the  0  angle  has  to  be 
considered.  The  variations  of  the  Euler  angles  is  in  Figures  6.  Not  null  variations  of  the  angles  along  Y  and  Z  axes  is 
observed:  (i)  for  the  0  angle  the  variation  is  of  magnitude  order  of  10“^  deg  and  (ii)  for  the  angle  the  variation  is 
constant. 
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Fig.  6.  Results  obtained  by  VICON  measures  of  pendulum  inclination  for  the  yaw  moments  of  inertia  (left)  and  for  the 
pitch  moments  of  inertia  (right) 

In  both  cases,  a  polynomial  interpolation  of  the  VICON  data  is  proposed,  to  know  at  each  time  step  the  time  history 
of  the  pendulum  inclination  angle.  If  the  time  history  is  known  in  polynomial  form,  the  time  derivative  0  =  ^  has  a 
straightforward  expression  and  it  could  be  easily  evaluated.  A  second  order  polynominal  approximation  is  proposed  in 
the  form 


and  the  time  derivative  is 


6>(t)  =  ait^  +  a2t  +  as 


^{t)  =  2ait  +  a2 
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Fig.  7.  Object  and  zero  position  of  the  hexacopter  on  VICON 

where  ai,  a2  and  as  are  the  polynomial  coefficient.  This  approximation  is  applied  to  both  moments  of  inertia.  In  that 
way,  the  only  unknown  variable  of  Eq.  2  is  the  moment  of  inertia. 
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where  Ozz  and  Oyy  are  evaluated  from  Fig.  9. 

For  the  validation  of  the  obatined  results  the  Lagrangian  approach  is  applied  to  the  pendulum.  The  setup  of  the 
experiments  is  in  Fig.  8. 


Fig.  8.  Setup  for  the  Lagrangian  approach 

The  kinetic  and  potential  energy  can  be  defined  as  follows 


K  —  +  Irod  + 

V  =  mg{l  —  ^  cos  0)  +  mi^(l  —  (/i  +  d)  cos  0) 


where  li  is  the  distance  between  the  joint  point  of  the  rod  and  the  hexacopter  and  the  yellow  bar,  d  is  the  distance 
between  the  joint  point  and  the  CoG  of  the  hexacopter,  m  is  the  hexacopter  mass,  mi  is  the  rod  mass  and  0  is 
the  pendulum  inclination  angle.  Cod  is  the  moment  of  inertia  of  the  bar,  that  is  easily  evaluated  from  the  rules  of 
parallelepiped  inertia,  starting  from  the  known  data  of  weight  and  geometry.  /  is  the  hexacopter  moment  of  inertia, 
that  is  unknown.  The  angle  d,  as  in  the  previously  cases,  is  evaluated  by  VICON.  Applying  the  Lagrangian  equation. 


_d  ^  ^ 

Jv~d^  ^  ~de 


=  0, 


with  H  =  and  =  Bsin6>. 


For  small  angle  of  inclination,  the  natural  frequancy  of  oscillation  can  be  evaluated  as 


where  uj  is  the  natural  frequency. 


= 


B 

A 
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From  VIC  ON  experiments,  the  period  of  oscillation  of  the  pendulum  is  known  and  can  be  easily  evaluated  from  the 
analysis  of  the  time  history.  So,  we  can  validate  at  least  two  moments  of  inertia.  The  time  histories  are  in  Figure  9. 
The  period  of  oscillation  for  the  yaw  angle  {Cz  evaluation)  is  =  1.4260  s  and  for  the  pitch  angle  {lyy  evaluation)  is 
Ty  =  1.3909  s. 

In  detail,  we  have 


with  Thexa  period  of  oscillation,  and 


I 


rj^2 

+  mig{li  +  d)) 


^l{^l  “1“^)  ^rod' 


(3) 


(4) 

(5) 


Fig.  9.  Time  histories  of  the  yaw  and  pitch  angles 

The  results  obtained  with  the  two  experiments  are  very  similar,  as  in  Table  3. 

3.2  Engine  Identification 


The  thrust  and  aerodynamic  torque  produced  by  a  propeller  can  be  related  to  the  rotational  speed  of  the  propeller 
blades.  The  problem  is  that  no  direct  relationship  between  the  motor  input  signal  and  the  propeller  angular  speed 
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Table  2.  Moments  of  inertia  of  the  aluminium  rod 


Todx 

0.0071  kgm^ 

Tody 

2.948  •  10-5  y.g^2 

Todz 

0.0071  kgm^ 

Table  3.  Comparison  between  the  moments  of  Inertia  obtained  with  both  methods 


Moments  of  inertia 

Pendulum  Approach 

Lagrangian  Approach 

Ty 

0.0497  kgm‘^ 

0.0573  kgm^ 

Izz 

0.0895  kgm^ 

0.0837  kgrn^ 

exists.  The  main  idea  of  the  identification  of  the  engine  is  to  derive  a  simplified  relation  of  the  thrust  generation  model 
as  in  [4].  If  the  rotational  speed  of  propeller  i  is  denoted  then  the  generated  thrust  Ti  is 

Ti  =  krnj  (6) 

where  kT  is  a  propeller  specific  constant.  In  the  same  way,  the  aerodynamic  torque  Ci  of  propeller  i  becomes 

Ci  =  kQ^ii  (7) 

where  kg  is  a  propeller  specific  constant  for  torque  experiments. 


The  thrust  constant  kr  defines  the  relationship  between  the  steady  state  thrust  generated  by  the  engines  when  hovering 
and  by  the  angular  velocity  of  the  rotors.  The  hexacopter  is  fixed  to  a  solid  bar  as  a  pendulum  (see  Fig.  10)  and  only 
one  propeller  is  mounted. 


Fig.  10.  Setup  for  the  thrust  experiments 

As  in  Fig.  11,  the  thrust  is  obtained  from  the  following  equilibrium  of  moments  around  the  point  1 

nirlrg  sin  0  +  mg  sin  OI2  —  T/  =  0, 

where  is  the  rod  mass,  C  is  the  distance  beween  the  point  1  and  the  CoG  of  the  rod,  m  is  the  hexacopter  total 
mass,  I2  is  the  distance  between  the  point  1  and  the  hexacopter  CoG,  I  is  the  distance  between  the  point  1  and  the 
application  point  of  the  thrust,  and  T  is  the  thrust  of  the  single  engine. 

Different  experiments  are  performed  at  different  rotational  speed  of  the  engine,  in  that  way  an  analytical  relationship 
between  the  thrust  T  and  the  rotational  speed  in  PWM  can  be  derived. 

As  explained  before,  the  input  signal  is  in  PWM  and  it  is  generated  by  the  PixHawk  with  a  limited  boundary  from 
1000  s  to  2000  s.  Motors  have  no  response  in  case  of  PWM  values  smaller  than  the  lower  limit.  On  the  other  hand,  a 
saturation  phenomenon  occurs  for  values  larger  than  the  upper  limit  of  PWM.  The  experimental  data  are  reported  in 
Table  4.  The  value  of  thrust  is  related  to  a  single  engine.  The  idle  value  of  PWM  is  1169  s,  when  the  hexacopter  is 
on  ground  with  the  engines  switched  on.  The  maximum  value  of  PWM  is  1803  s,  that  corresponds  to  about  4.7  N  for 
each  engine.  After  this  value,  no  significant  variation  of  the  thrust  value  can  be  observed. 

An  example  of  the  experiments  is  in  Figure  12,  both  VICON  and  PWM  measures  are  considered.  The  VICON  measure  is 
related  to  the  inclination  angle  (0)  of  the  pendulum  when  the  hexacopter  is  in  the  configuration  of  Fig.  11.  The  PWM 
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1 


Fig.  11.  Scheme  for  the  thrust  experiments 

measure  is  the  output  of  the  PixHawk  autopilot.  During  flight  test  experiments  we  have  verified  that  the  hovering 
condition  is  at  about  1500  PWM,  that  is  about  2.14  N  for  each  motors  (=  12.8  N  for  the  overall  configuration). 


PixHawk  Measures 


VICON  Measures 


Fig.  12.  Example  of  the  results  obtained  with  VICON  and  PixHawk  measures 

Table  4.  Experimental  data  for  thrust  identification 


PWM  [s] 

Thrust  [N] 

1169 

0 

1574 

2.2119 

1646 

2.9366 

1657 

3.0123 

1775 

4.2924 

1803 

4.6627 

The  final  relationship  between  PWM  and  thrust  is 

T[N]  =  0.0071  •  PWM[s]  -  8.5806, 

considering  a  linear  interpolation  between  the  experimental  data.  The  obtained  curve  is  in  Eig.  13.  The  thrust  constant 
kr  as  in  Eq.  6  is  equal  to  1.2736  •  10“^  Ns^. 
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PWM  [ms] 


Fig.  13.  Thrust  variation  with  respect  to  PWM  measures 

The  torque  constant  kq  relates  the  rotational  speed  of  each  rotors  in  idle  position  to  the  torque  produced  by  the  rotor 
with  respect  to  the  motor  axis.  To  find  an  estimate  of  this  constant,  we  use  a  frictioless  system  based  on  experiments 
performed  on  a  granite  rig  with  floating  spacecraft.  See  Figure  15  for  the  experiment  setup.  The  hexarotor  is  mounted 
on  a  spacecraft  that  was  developed  at  the  NPS  laboratory  of  Prof.  Romano  [9]  and  the  facilities  used  for  the  experiments 
are  on  the  NPS  Robotics  Spacelab  of  Prof.  Romano  [19]  (Fig.  14). 


Fig.  14.  The  Floating  Spacecraft-Simulator  Testbed  at  Spacecraft  Robotics  Laboratory  (NPS) 

The  main  floating  surface  is  a  granite  monolith  with  the  following  characteristics: 

•  Dimensions:  4  m  x  4  m  x  0.3  m 

•  Surface  precision  grade:  AAA 

•  Planar  accuracy:±0. 127x10“^  mm 

•  Horizontal  leveling  precision:  <0.01  deg 

•  Mass:  15.2  x  103  kg  . 

The  testbed  is  also  provided  with: 

•  Linux  Real-Time  work  station 

•  Ad-Hoc  WiFi  internal  network  for  data  streaming 

•  High  pressure  air  compressor  and  compressed  air  filling  station. 
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Fig.  15.  Testbed  setup  for  torque  experiments 

Three  propellers  rotating  in  the  same  direction  are  mounted  on  the  hexacopter.  The  spacecraft  is  floating  on  the  granite 
rig  with  four  thrusters  on.  Two  experiments  are  performed: 

(1)  no  propellers  switched  on  and  four  thrusters  switched  on  for  5  seconds, 

(2)  three  propellers  and  four  thrusters  switched  on. 

The  torque  is  assumed  to  be  constant  for  all  the  experiments  with  propellers  switched  off.  The  VIC  ON  measures  with 
no  propellers  are  in  Fig.  16. 


4  - 1 - 1 - 1 - 1 - r 
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Fig.  16.  VIC  ON  measures  for  experiment  1  (no  propellers  switched  on) 

In  general,  the  torque  r  is  measured  starting  from  the  Newton’s  second  law 

T  —  luJp^Qp.)  (8) 

with  I  moment  of  inertia  along  the  Zb  of  the  system  of  Fig.  15,  that  means  the  spacecraft  and  the  hexacopter  moments 
of  inertia  and  Cprop  is  the  angular  rotational  speed  of  the  body.  The  experiments  with  the  propellers  off  are  performed 
for  the  evaluation  of  the  moment  of  inertia  of  the  body  /,  because  the  torque  is  constant  and  equal  to 
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To  =  2dF 

where  tq  is  the  measured  torque  with  the  propellers  off,  d  is  the  distauce  betweeu  two  thrusters  aud  F  =  0.15  N  is  the 
force  produced  by  the  four  thrusters.  lu  our  case,  tq  is  equal  to  0.0030  Nm. 

Table  5.  Experimeutal  data  for  torque  ideutificatiou 


PWM  [s] 

Torque  [Nm] 

1169 

0.0248 

1203 

0.0313 

1310 

0.0388 

1520 

0.0603 

1844 

0.0715 

The  fiual  relatiouship  betweeu  PWM  aud  torque 


r[Nm]  =  0.0001  •  PWM[s]  -  0.0520, 

cousideriug  a  liuear  iuterpolatiou  betweeu  the  experimeutal  data.  The  obtaiued  curve  is  iu  Fig.  17.  The  thrust  coustaut 
kq  (as  iu  Eq.  7)  is  equal  to  2.4325  •  10“^  Nms^. 


Fig.  17.  Torque  variatiou  with  respect  to  PWM  measures 

For  the  implemeutatiou  of  the  coutroller,  the  relatiouship  betweeu  the  rotatioual  speed  of  each  rotor  iu  Revolutious 
Per  Miuute  {RPM)  aud  iu  PWM  is  ueeded.  For  this  reasou,  we  use  some  experimeutal  data  (previously  collected  by 
NPS  group),  data  obtaiued  by  static  eugiue  tests  with  the  eugiue  uumouuted  from  its  arm.  The  experimeutal  data 
are  iu  Fig. 18.  The  data  are  riduudaut  for  each  rotatioual  speed  due  to  the  rules  of  the  actuator  disk  theory  [21].  This 
relatiouship  is  used  for  the  trausformatiou  betweeu  the  output  of  the  Ci  coutroller  (see  Sectiou  5)  aud  the  iuputs  of 
the  uouliuear  model  implemeuted  iu  Matlab  (see  Sectiou  7),  uot  ouly  for  the  thrust  evaluatiou  but  also  for  the  torque 
evaluatiou.  The  fiual  relatiouship  (see  Fig.  19)  is 

PWM[s]  =  0.1975  •  RPM[rad  \  5]  +  670.0442. 
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Fig.  18.  Thrust  vatiation  with  respect  to  RPM  measures  (static  tests) 


Fig.  19.  Relationship  between  RPM  and  PWM  measures,  and  viceversa 
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4.  NONLINEAR  AND  LINEAR  MODELS 

The  motion  of  a  rigid  body  can  be  decomposed  into  the  translational  and  rotational  components.  In  order  to  describe 
the  dynamics  of  the  hexacopter,  assumed  to  be  a  rigid  body,  the  Newton-Euler  equations  [14]  are  taken  into  account. 
Nine  equations  of  motion  are  considered:  (i)  three  equations  for  the  linear  speeds  with  components  (ii)  three 

angular  speeds  (p,  and  (hi)  three  angles  (0, for  the  orientation.  Eor  the  linear  and  angular  speeds,  we  have 

Fb  =  X  V  (9) 

Mb  =  Iuj'b  +  X  (Ilob)  +  Ip^B  x  ((— (10) 

where  Fb  G  and  Mb  G  are  the  total  forces  and  moments  acting  on  the  hexacopter,  respectively,  m  is  the 
hexacopter  total  mass,  V  =  (u,  u,  w)^  G  is  the  vector  of  linear  speeds,  ujb  =  (p,  4,  r)^)  G  is  the  vector  of  angular 
speeds,  /  =  diag{Ixx^  lyy^  Izz)  ^  is  the  inertia  matrix  (diagonal  due  to  the  hexacopter  symmetry)  with  respect  to 

the  body  axes.  Ip  is  the  moment  of  inertia  about  the  propeller  axis  and  is  obtained  as  ^mpr‘^  with  rrip  and  r  mass  and 
radius  of  the  propeller,  is  the  rotational  speed  of  each  propellers  (i  =  1, . . .  ,np)  with  Up  number  of  propellers.  The 
factor  (—1)*  comes  from  the  fact  that  the  propellers  rotate  in  opposite  directions.  All  quantities  are  expressed  in  the 
body  fixed  frame. 

The  attitude  of  the  body  is  described  by  three  Euler  angles  (0, 'd,'^)^,  which  are  defined  by  the  kinematic  equations 
and  it  can  be  obtained  integrating  the  following  equations 


(j)  =  p  q  sin  (j)  tan 'd  +  r  cos  (j)  tan 'd 
'd  =  q  cos  (j)  —  r  sin  (j) 

j  _  q  sin  4>  r  cos  0 

^  cos 'd  '  cos 'd 


(11) 

(12) 

(13) 


The  forces  and  torques  acting  on  the  hexacopter  are  gravity,  aerodynamic  forces,  air  friction  aerodynamic  forces  and 
torques  produced  by  the  propellers  and  the  gyroscopic  effects  from  the  rotation  of  the  propellers.  The  torque  caused 
by  the  angular  acceleration  of  the  propeller  has  been  neglected.  The  air  frames  movement  through  the  air  will  cause 
friction.  Eor  the  hexacopter  this  force  is  small  and  can  be  neglected. 

To  reduce  the  computational  time  and  to  simplify  the  complete  model,  the  aerodynamic  loads  are  calculated  expressing 
the  equations  as  Taylor-series-expansion  (small  angles  of  attack  considered),  for  different  propeller  angular  rate.  The 
only  not  negligible  aerodynamic  loads  are  acting  along  Zb  axis,  i.e.  the  thrust  and  the  reaction  torque.  The  method 
presented  in  [15]  has  been  used  to  verify  that  the  only  loads  noteworthy  are  along  Zb  axis.  Subsequently,  torque  and 
force  varying  with  rpm  were  measured  experimentally. 

In  the  second  equation  of  Eq.  9,  the  gyroscopic  torque  produced  by  the  propeller  can  be  found  due  that  a  rotating 
propeller  follows  the  rotations  of  the  airframe.  Note  that  for  multirotors  the  gyroscopic  terms  produced  by  propellers 
are  the  dominant  ones,  this  is  a  consequence  of  the  high  rotational  speed  in  hovering  (with  respect  to  the  gyroscopic 
term  due  to  the  body  angular  rates). 

The  components  of  the  total  speed  V  can  be  espressed  as  follows 


ii  =  qw  —  rv  Y  g  sin 'd 

(14) 

V  =  pw  Yru  —  g  cos 'd  sin  <p 

(15) 

Ti 

w=pv  —  qu  —  g  cos  iI  cos  0  —  — 

(16) 

and  the  variation  of  the  angular  speeds  is  expressed  by  the  following  equations 

P  =  “7^  [(^3  —  Y4  —  T5  +  Te)^!  +  (T2  —  Ti)lp  +  qT{Iyy  —  Izz) 

IpqO] 

(17) 

Q  =  7^  [(X3  —  T4  +  T5  —  TQ)d2  Y  pr{Izz  H — Ixx) 

+  IpP^] 

(18) 

r  =  7^[(^i  +  C2  -  C3  +  C4  -  C5  -  Ce)  -  pq{Ix. 

c  ~  ^yy)] 

(19) 

where  for  i  =  1, . . . ,  is  the  motor  thrust,  Q  for  i  =  1, . . . ,  is  the  motor  reaction  torque  and  O  = 

is  the  total  rotational  speed,  di  is  the  distance  between  the  motors  (3, 4,  5,  6)  and  the  Xb  axis.  Ip  is  the  distance  between 

the  motors  (1,  2)  and  the  Xb  axis,  ^2  =  is  the  distance  between  the  motors  (3, 4,  5,  6)  fand  the  Yb  axis. 

The  linear  model  is  obtained  with  linearization  of  the  complete  model  around  an  equilibrium  point,  that  is  the  hovering 
condition.  The  equilibrium  point  is  chosen  to  guarantee  zero  angular  rates.  The  speed  components  of  X  and  Y  axes 
are  zero,  instead  a  non  zero  value  is  imposed  for  the  vertical  speed  {w  =  0.2  m/s).  A  pitch  angle  of  0.02  deg  is  also 
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4  NONLINEAR  AND  LINEAR  MODELS 


(20) 


considered.  For  the  linear  mathematical  formulation  of  the  dynamic  system  a  standard  continous  time-invariant  state 
space  formulation  is  derived,  as  follows 

x{t)  =  Ax{t)  -f  Bu{t), 
y{t)  =  Cx{t),  x(0)  =  Xo, 

is  the  state  vector,  u{t)  =  (f^i,  (22,  (23,(24,(25,  (25)^  G  is  the  control  signal, 
1^9x9  state  matrix,  B  G  is  the  control  matrix,  C  G  is  the 

output  matrix,  (2^  is  the  rotational  speed  of  each  motor  and  I  is  the  number  of  outputs.  For  the  implementation  of  the 


where  x{t)  =  {u^  rc,p,  g,  r,  0,  6>,  G  M: 
y{t)  G  is  the  controlled  output.  A  G 


A  = 


and  control  matrix 


B  = 


0 

0 

—kT 

-Ct^ 

0 

.  kq 


Ct2 

0 

kq 


.  so  we 

have  that  x  =  { 

0  0 

0 

-0.20  O' 

0  0 

0.20 

0  0 

0  0 

0 

0  0 

0  0  -( 

3.0001 

0  0 

0  0 

0  0.0001  0 

0  0 

0 

0  oj 

0 

0 

0 

0 

0 

0 

0 

0 

—kT 

—kT 

—kT 

—kT 

— kTdi 

kTd\ 

kr^l 

-CT^l  kr^l 

'  -kT^l 

-kq 

kq 

-kq 

-kq  . 

(21) 


(22) 


are  obtained,  where  kT  and  kg  are  the  engine  thrust  and  torque  gains  (see  Section  3.2),  I  is  the  distance  between  engines 
1  and  2  from  the  CoG  along  Yb  axis  and  di  =  y.  See  Fig.  2  for  the  details. 

The  obtained  B  matrix  is  not  invertible,  thus  a  change  of  control  variables  is  required  to  avoid  singularity  in  the 
controller  implementation.  Virtual  control  inputs  are  defined  considering  that  each  rotor  causes  an  upwards  thrust  force 
and  generates  a  moment  with  direction  opposite  to  the  direction  of  rotation  of  the  corresponding  rotor  i.  Thus,  the 
linear  system  in  Eq.  20  could  be  rewritten  as 

xc^  (t)  =  AxjC^  (t)  +  Buc^  (t), 
y{t)  =  Cx£,(t),  x(0)  =  xo, 

where  xc^  =  is  the  reduced  state  vector,  =  ('T’i, 'r’2, 'T’s,  ^’4)^  is  the  virtual  input  vector,  that  is 


(23) 


vi  = 

V2  = 
Vs  = 

V4^  = 


kT^t^ 


-A)t|((2?  -  ol)  +  kTdi{ol  -nl-nlY  nl) 
kr^ml-nl  +  nl-nl) 
kginj  +  (2^  -  (2^  +  (2^  -  (2^  -  nl). 


(24) 


A  and  B  are  defined  as 


A  = 


0  0  0  O' 

0  -0.0001  0  0 

0  0  0.0001  0 

0  0  0  0 


B  =  Ia 
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5.  Cl  ADAPTIVE  CONTROLLER 

The  choice  of  the  Ci  adaptive  controller  for  the  aircraft  control  is  motivated  by  the  high  level  of  uncertainty  which 
generally  characterizes  UAVs.  The  Ci  adaptive  controller  here  applied,  extensively  described  in  Reference  [20],  takes 
into  account  unmatched  uncertainties  which  include  unmodeled  dynamics  and  state-  and  time-dependent  nonlinearities. 
The  adaptive  law  is  a  piecewise  constant  law,  as  explained  in  [6,  34],  that  guarantees  fast  estimation,  the  adaptation 
rate  can  be  associated  with  the  sampling  rate  of  the  autopilot  board  CPU.  Moreover,  this  adaptive  algorithm  guarantees 
bounded  inputs  and  outputs,  uniform  transient  response  and  steady-state  tracking.  This  extension  of  the  Ci  controller 
was  applied  to  NASA’s  AirSTAR  ([18])  and  to  the  Boeing  X-48B  ([22]).  A  key  feature  of  this  controller,  as  explained 
in  the  previous  works,  is  that  the  hardware  interface  is  executed  at  a  lower  rate  (about  10  —  100  Hz)  than  the  control 
algorithm  (about  100  —  1000  Hz),  therefore  demanding  insignificant  CPU  power.  Thus,  the  computational  power  can 
be  used  for  fast  adaptation. 

The  above  described  controller  is  designed  to  control  the  general  linear  system  of  Equation  (20)  which,  considering 
uncertainties,  can  be  rewritten  as 


X{t)  =  AmX{t)  -h  -h  z{t)A),  ^(0)  =  Xq, 

z{t)  =  go{xz{t)A),  Xz{t)  =  g{xz{t),x{t)A),  ^^(0)  =  (25) 

y{t)  =  Cx{t). 

The  matrix  A^  G  is  Hurwitz  and  specifies  the  desired  dynamics  of  the  closed- loop  system,  G  and 

C  G  are  known  constant  matrices.  Compared  to  system  (20),  system  (25)  includes  uj  G  the  unknown 

frequency  gain  matrix,  z{t)  and  Xz{t)  respectively  the  output  and  state  vector  of  internal  unmodeled  dynamics  and  the 
unknown  nonlinear  functions  /(•),  g{')  and  go{’). 


Another  form  for  the  first  line  of  system  (25)  is 

x{t)  =  AmX{t)  -h  Bm{uju{t)  +  fi{x{t),z{t)A))  +  H^m/2 (^(^) ,  ^(0 U) ,  ^(0)  =  Xq,  (26) 


with  Burn  ^  is  constant  matrix  such  that  B^Bum  =  0  and  the  rank  of  B  =  [Bm  Bum]  is  n.  The  unknown 

nonlinear  functions  /i(')  and  /2(')  satisfy  the  condition 


fi{x{t),z{t)A) 

f2{x{t),z{t)A) 


B  ^f{x{t),z{t)A)^ 


The  state  predictor  is  defined  as 

x{t)  =  AmX{t)  +  Bm{lXou{t)  +  +  Bum^2{t),  ^(0)  =  SJq 

where  G  i?”*  and  d'2{t)  G  i?""”*,  with  uiq  a  suitable  value  for  ui.  The  adaptation  laws  are 

B-^^-\T,)fi{iT,),  (27) 

for  i  =  0, 1,  2, ...,  and  t  G  [iT^,  {i  +  l)Ts],  where  >  0  is  the  adaptation  sampling  time  associated  with  the  sampling 
rate  of  the  CPU  installed  on  the  autopilot  board.  In  Equation  (27)  also  appear 

<E>(T,)  =  -  In),  G 

where  x{t)  =  x{t)  —  x(t)  is  the  error  between  the  system  state  and  the  predicted  state. 

Einally,  the  last  element  of  the  controller  is  the  control  law  defined  as 


ai{t) 

Im  0 

(72(f)  _ 

0  In— m 

u{t)  =  -Kx{t). 

Calling  s  the  complex  argument  resulting  from  the  Laplace  transform  of  the  corresponding  time  domain  signal,  it  is 
possible  to  define 

X(s)  =  D{s)fi{s), 

fj{t)  =  Ulou{t)  +  +  fl2m{t)  -  rg{t), 

=  ai{t), 

rg{s)  =  Kg{s)r{s). 

D{s)  is  a  proper  stable  transfer  matrix  of  dimension  m  x  m,  r{t)  is  the  reference  signal.  The  transfer  functions  Hrn  and 
Hum  are  calculated  starting  from  the  matrices  of  systems  (25)  and  (26) 

Hm{s)  =  C{sln  -  Am)~^Bm 

^um(,^)  ~  C i^sln  Am)  B^m 
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while  the  prefilter  Kg{s)  is  chosen  as  the  constant  matrix  Kg  =  —(CA^Bj^)  ^  to  achieve  decoupling  among  the  signals. 

The  first  step  is  to  find  the  matrix  which  describes  the  desired  closed  loop  dynamics.  This  Hurwitz  matrix  is  found 
using  the  pole  placement  theory.  The  pole  placement  must  be  done  considering  the  desired  dynamic  specifications.  A 
robust  eigenstructure  is  assigned  taking  into  account  that  the  more  negative  is  the  real  part  of  the  poles,  the  faster  is 
the  speed  with  which  the  system  reaches  its  steady  state.  If  the  state  feedback  is  designed  by  eigenstructure  assignment, 
not  only  the  eigenvalues  but  also  the  right  generalized  eigenvectors  can  be  assigned  [30,  32]. 

For  the  Ci  controller  is  not  necessary  that  the  desired  dynamics  are  near  to  the  real  one,  as  said  before.  The  desired 
response  is  chosen  considering  the  change  of  variables  described  in  Section  4  and  in  Eq.  24: 

•  All  the  inputs  are  decoupled. 

•  Fast  response  on  the  pitch  and  roll  variable 

•  Slow  response  on  the  variation  of  the  vertical  speed  and  on  the  yaw  axis. 

Usually,  the  variation  of  the  vertical  speed  and  of  the  yaw  angle  should  be  slower  than  the  other  dynamics  for  multirotors, 
to  avoid  sudden  responses  on  Zb-  The  desired  step  response  dynamics  is  in  Fig.  20.  The  blue  line  is  the  behaviour  before 
the  decoupling  of  the  controlled  variables,  and  the  green  line  is  the  linear  behaviour  with  decoupled  input  variables. 
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Fig.  20.  Step  response  of  the  desired  linear  system 


An  important  feature  of  the  jCi  controller  is  that  the  error  between  the  closed  loop  system  with  the  jCi  controller  and 
the  reference  controller  can  be  uniformly  bounded  by  a  constant  inverse  proportional  to  the  square  root  of  the  rate 
of  adaptation,  similar  to  the  tracking  error  [20].  The  selected  time  step  is  equal  to  =  100  Hz,  due  to  on-board 
microcontroller  constraints. 

Another  important  key  aspect  is  that  this  controller  defines  the  control  signal  as  the  output  of  a  low  pass-filter  to 
guarantee  that  the  control  signal  stays  in  the  low-frequency  range.  This  feature  permits  to  avoid  high  frequency 
oscillations  due  to  the  large  adaptation  gain.  In  systems  that  use  electric  devices  these  oscillations  significantly  increase 
the  current  draw  and  it  is  undesirable.  Thus,  the  inner  loop  control  objective  is  to  design  a  full  state  feedback  controller 
for  the  system  such  that  all  the  closed  loop  signals  remain  bounded  and  the  system  tracks  the  state  of  a  desired  reference 
model. 

A  model  obtained  from  experimental  flight  tests  can  present  some  variations  with  the  ideal  case,  but,  if  the  controller 
do  not  require  a  retuning,  this  controller  can  be  considered  robust,  due  to  good  performance  in  terms  of  overshoot 
and  rise  time.  The  Ci  controller  can  be  implemented  to  limit  the  range  of  the  angular  velocities  and  of  the  four  rotor 
rotational  speed.  Notice  that  a  quadrotor  is  an  unstable  platform,  thus,  if  a  sudden  maneuver  is  implemented,  it  can 
cause  glitches  on  the  parameters  trend  and  the  aircraft  could  become  uncontrollable. 
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6.  LINEAR  QUADRATIC  REGULATOR 

The  theory  of  optimal  control  is  concerned  with  operating  a  dynamic  system  at  minimum  cost.  The  case  where  the 
system  dynamics  are  described  by  a  set  of  linear  differential  equations  and  the  cost  is  described  by  a  quadratic  function 
is  called  the  LQ  problem.  One  of  the  main  results  in  the  theory  is  that  the  solution  is  provided  by  the  linear-quadratic 
regulator  (LQR).  The  results  obatined  with  the  £i  adaptive  controller  are  compared  with  this  robust  controller. 

Starting  from  state-space  model  (see  Equation  23),  the  controlled  output  y(t)  corresponds  to  a  signal  that  has  to  be 
small  as  possible  in  the  shortest  possible  amount  of  time.  In  this  case,  the  controlled  output  is  coincident  with  the 
measured  one,  which  corresponds  to  the  signal  that  can  be  measured.  The  optimal  LQR  problem  consists  of  finding 
the  controller  transfer-matrix  C(s)  that  minimizes  the  cost  function  Jlqr  [H]-  The  assumption  is  that  the  whole  state 
x(t)  can  be  measured  and  it  is  available  for  control. 

The  cost  function  can  be  defined  as 

POO 

Jlqr=  /  {x'{t)Qx{t)  ^  pu'{t)Ru{t))dt  (28) 

Jo 

where  Q  G  is  a  symmetric  positive-definite  matrix,  R  G  a  symmetric  positive-definite  matrix,  p  is  a  positive 

constant,  n  is  the  state  vector  dimension  and  m  is  the  input  vector  dimension.  The  optimal  state-feedback  controller  is 
a  simple  matrix  gain  of  the  form 


u  =  —Kx 

where  K  G  is  given  by  the  following  expression 

K  =  pR-lB^P{t), 

ans  P{t)  is  found  by  solving  the  continuous  time  Algebraic  Riccati  Equation  (ARE), 

A^P{t)  +  P{t)A  -  P{t)BR-lB^P{t)  PQ  =  -P{t). 

The  matrices  Q  and  R  are  chosen  using  the  Bryson’s  rule  [17],  that  is  select  Q  and  R  diagonal  with 


Qi 


maximumacceptabl  evalueofx‘f 

1 


maximumacceptabl  evalueofu‘^ 


,i  G  (l,2,...,n) 
j  G  (l,2,...,m) 


which  correspond  to  the  following  criteria 


poo  n  jn 

Jlqr  =  /  >  Qu^j  jt)  +  ^ 

J^  i=i  j=i 

A  crucial  property  of  LQR  controller  design  is  that  this  closed-loop  is  asymptotically  stable  as  long  as  the  following  two 
conditions  hold: 

(1)  The  system  is  controllable. 

(2)  The  system  is  observable. 

In  the  analyzed  case,  the  rank  of  the  matrix  (A,  B),  that  is  the  controllability  matrix,  is  equal  to  4.  Thus  the  state  space 
system  in  (23)  is  controllable.  The  observability  is  guaranteed  because  the  output  matrix  C  is  the  identity  matrix. 

Eor  any  bounded  input  u(t)^  the  output  y(t)  and  the  state  x{t)  are  also  bounded,  i.e. 

||'?^(^)||  <  ci,Vt  >  0 
||^(t)||  <  C2,Vt  >  0 
\\x{t)\\  <  C3,\ft  >  0, 

with  Cl,  C2  and  C3  defined  boundaries.  Moreover,  if  u{t)  converges  to  zero  as  t  ^  00,  then  x{t)  and  y{t)  also  converge 
to  zero  as  t  ^  00. 

Eor  the  analyzed  hexacopter,  the  control  is  assigned  by  the  four  virtual  inputs  Vi  (Eq.  24)  and  the  outputs  are 
y  =  (w^p^q^r)'^ .  The  LQR  weights  are  equal  to  0.6,  both  the  state  and  input  weight. 
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7.  SIMULATION  AND  EXPERIMENTAL  RESULTS 

Some  simulations  are  performded  for  validate  the  nonlinear  model  and  for  evaluate  the  performance  of  LQR  and  jCi 
controllers  in  closed  loop. 

In  the  first  case,  the  nonlinear  model  implemented  on  Simulink  and  the  experimental  flight  performed  with  the  PixHawk 
are  compared.  Starting  from  the  identification  of  the  dynamic  models,  a  complete  nonlinear  model  is  implemented  in 
Matlab/Simulink,  considering  Eqs.  11-17.  A  Matlab  function  is  implemented  for  the  calculations  of  the  thrust  and  torque 
of  each  engines.  Eor  the  validation,  the  time  history  of  the  rotational  speeds  of  the  rotors  has  to  be  analyzed.  Starting 
from  the  experimental  flight,  performed  in  the  NPS  laboratory,  the  inputs  of  the  nonlinear  model  should  be  the  vector 
of  time  (uniformly  distributed  and  with  a  fixed  sample  time)  and  the  variations  of  PWM  (outputs  of  the  PixHawk). 
In  Eig.21  the  command  block  and  the  Matlab  function  are  reported.  All  the  inputs  obtained  in  the  experimental  flight 
have  to  be  separetely  saved  and  converted  in  rpm^,  that  is  the  input  of  the  nonlinear  model  and  also  the  output  of  the 
jCi  controller. 


cmd 

(rpm*2) 


omegajMfm 

j 

ontega  ^  Tj 
pwm  Q  , 

Omega 

MATLAB  Function  1 


. _ ^  ^ _ _  1  ^ 

•  1 

I  ^ 

I  ^ 

Ffom  File 

1.  _  1 

|input_  mat  | 

I  ^ 

From  File1 

inoot  3  n  t  I 

.mat  I 

I  ^ 

From  File2 

noirt  4 

From  File3 

I  ^ 

r  Tb  TI 

|inpu_  mat  | 

I  ^ 

From  File4 

_ 

w 

Eig.  21.  Matlab  model  of  the  nonlinear  system 

As  previously  discussed,  from  static  tests  of  the  single  engine  we  could  define  PWM-RPM  and  viceversa  (see  Eig.  19). 
In  that  case,  we  know  the  PWM  variations  from  the  PixHawk  logs  and  we  would  like  to  evaluate  the  variation  of  the 
rpm,  that  is 


RPM[rad  \s]=  0.0049  •  10^  •  PWM[s]  -  3.0786. 
The  variations  of  the  inputs  are  in  Eig. 22. 


time  [s] 


time  [s] 


time  [s] 


time  [s] 


Eig.  22.  Input  variations  from  PixHawk  experiments 

The  measured  outputs  from  the  PixHawk  are  the  attitude  angles.  The  compared  results  are  in  Eig.  23.  Similar  results 
are  obtained  for  the  variation  of  the  pitch  angle,  instead  for  the  roll  and  yaw  angles  the  errors  between  the  nnlinear 
simulated  model  and  the  real  one  is  not  neglegible.  An  error  of  about  3  deg  is  measured  for  the  roll  angle  and  of  about 
10  deg  for  the  yaw  angle.  This  is  probably  due  to  evaluation  of  the  moments  of  inertia.  However,  due  to  the  hihgly 
nonlinearity  of  the  analyzed  system  the  obtained  results  can  be  considered  acceptable,  taking  into  account  that  the 
scope  of  the  project  is  the  implementation  of  a  feedback  controller. 
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Fig.  23.  Comparison  between  the  nonlinear  model  and  the  experimental  flight.  Red  line  =  Experimental  flight,  Blue 
line  =  Simulated  Nonlinear  Model 


For  the  validation  of  the  identification  of  the  engine  characteristics  and  of  the  implementation  on  Matlab/Simulink,  the 
output  of  the  Mat  lab  function  in  Fig.  21  are  also  considered.  The  time  histories  of  the  following  variables  are  analyzed: 

(1)  the  variation  of  PWM  with  respect  time,  that  has  to  be  compared  with  the  time  histories  of  the  experimental 
flight, 

(2)  the  variation  of  thrust  of  each  engine  as  in  Eq.  6, 

(3)  the  variation  of  the  torque  of  each  engine,  as  in  Eq.  7. 

As  clear  from  Fig.  24,  a  correct  interpolation  of  the  data  is  performed  in  the  implementation  of  the  Matlab  model. 
Miminum  error  can  be  obtained  from  the  simulated  input  variations  and  the  real  flight  inputs. 

The  second  step  is  the  implementation  of  the  LQR  controller  and  of  the  Ci  controller  in  Matlab.  See  Figs.  27  and  28. 

As  in  Fig.  27,  for  the  implementation  of  both  controllers,  the  time  history  definition  of  the  variable  Vi  is  required.  As 
indicated  in  Eq.  24,  the  virtual  inputs  are  function  of  the  variation  of  the  rotational  speed  (square  of  these  variations) 
and  of  the  constants  related  to  the  thrust  and  torque  variations  (Eqs.  6  and  7). 

Two  cases  are  considered  for  the  comparison  of  the  proposed  controllers: 

•  ideal  case 

•  experimental  case 

For  the  ideal  case,  considering  the  time  histories  of  the  experimental  virtual  inputs,  we  have: 

(1)  a  step  variation  of  about  10  N  is  imposed  on  the  virtual  input  vi^  that  is  the  input  related  to  the  thrust  and,  as 
consequence,  related  to  the  hovering  maneuver. 

(2)  a  doublet  maneuver  of  0.00087  Nm  is  imposed  on  the  virtual  inputs  V2  and  at  different  time  step. 

(3)  a  step  variation  of  about  0.00018  Nm  is  imposed  on  the  virtual  input  v^. 

See  Fig. 29  for  the  graphical  variations  of  the  virtual  inputs.  These  virtual  inputs  are  transformed  in  variations  of  the 
rotational  speeds  of  the  six  rotors  using  the  Moore-Penrose  pseudoinverse  [24,  26],  that  is  a  generalization  of  the  inverse 
matrix  and  is  unique. 
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Fig.  24.  Comparison  between  the  PWM  variations  of  the  nonlinear  simulated  model  and  the  experimental  flight.  Red 
line  =  Experimental  flight,  Blue  line  =  Simulated  Nonlinear  Model 


As  in  Figs.  30-33,  we  can  observe  that  both  controllers  have  good  performance  following  ideal  step  variations  of  the 
input  variables.  The  implementations  of  the  LQR  controller  cannot  provide  any  information  about  the  sample  time  of 
the  simulations  and  about  the  assigned  controlled  inputs.  With  the  Ci  adaptive  controller  we  could  observe  also  the 
variations  of  the  controller  assigned  inputs.  See  Fig.  34. 

Considering  an  example  of  flight  tests,  as  in  the  previous  case,  the  time  histories  of  the  virtual  inputs  are  in  Fig.  35. 
For  the  validation  of  both  controllers,  these  inputs  are  considered. 

The  time  histories  of  the  controlled  variables  are  in  Figs.  36-39.  As  in  the  previous  case,  both  controllers  have  good 
behaviour,  even  if  the  inputs  are  noised  and  not  filtered. 

The  controlled  jCi  inputs  are  in  Fig.  43.  For  the  £i  adaptive  controller  we  could  also  simulate  the  following  cases: 

(1)  ideal  inputs  that  include  an  actuator  model  with  time  delay, 

(2)  experimental  inputs  that  include  an  actuator  model  with  time  delay, 

(3)  nonlinear  model  that  include  an  actuator  model  with  time  delay. 

In  the  LQR  controller  we  cannot  include  an  actuator  model  and  we  cannot  simulate  the  behaviour  of  the  nonlinear 
model.  To  validate  the  LQR  with  time  delay,  we  have  to  flight  with  the  hexacopter  and  upload  the  output  time  histories 
of  the  PixHawk. 

A  different  time  delay  is  considered  for  all  channels: 

(1)  a  time  delay  of  one  sample  time  (0.01  s)  in  the  virtual  input  ui, 

(2)  a  time  delay  of  0.02  s  in  the  virtual  input  U2, 

(3)  a  time  delay  of  one  sample  time  (0.01  s)  in  the  virtual  input  U3, 

(4)  a  time  delay  of  0.04  s  in  the  virtual  input  U4. 
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Fig.  25.  Time  history  of  the  thrust  variation  of  the  six  engines 

A  first  order  transfer  function  is  considered  for  all  channels  for  the  simulation  of  the  actuator  model.  The  time  delay  is 
considered  for  simulate  a  delay  in  the  connection  between  the  input  signal  sent  by  Matlab  UDP  sender  and  the  UDP 
receiver  on  PixHawk  model.  This  connection  is  briefly  described  on  Section  8. 

The  first  analyzed  case  is  related  to  the  ideal  inputs  with  a  delay  and  an  actuator  model  on  the  controlled  input.  The 
delay  is  introduced  between  the  output  of  the  control  law  and  the  hexacopter  model.  The  obtained  results  are  in  Fig.  40. 
As  visible  from  the  obtained  results,  the  zero  value  of  the  variables  is  easily  reached  before  the  end  of  the  simulations. 
However,  the  maximum  value  of  each  variables  is  never  reached. 

The  second  analyzed  case  is  related  to  the  experimental  inputs,  including  an  actuator  model  with  time  delay.  The 
obtained  results  are  in  Fig.  41. 

The  last  case  considered  is  the  nonlinear  model  with  time  delay  and  actuator  models  between  the  controller  outputs  and 
the  hexacopter  model.  For  clearly  understand  the  obtained  results,  the  nonlinear  model  should  be  rewritten  considering 
the  changed  of  input  variables.  The  Eqs.  14  and  17  are  rewritten  as 


w  =  pv  —  qu  —  g  cos 'd  cos  0  +  ^  (29) 

P  ~  777  [^2  T  Q'^i.^yy  ^zz)  ^pQ^]  (^0) 

Q  ~  7^ [^3  T  P^^i^zz  ^xx)  T  ^pP^] 


The  inputs  of  the  nonlinear  model  are  the  virtual  inputs  Vi  and  the  outputs  are  y  =  {w^p^q^r)"^ .  In  that  case,  in  the 
comparison  between  the  assigned  inputs  and  the  obtained  outputs,  we  have  to  take  into  account  that  the  virtual  inputs 
are  only  a  part  of  the  nonlinear  model.  Thus,  if  the  time  history  of  the  vertical  speed  w  is  analyzed,  we  can  observe 
that  this  speed  is  not  stabilized.  This  is  due  because  the  variation  of  the  other  linear  speed  components  influence  its 
behaviour,  and  u  and  v  are  not  controlled.  The  time  histories  of  all  the  angular  speeds  is  coupled  by  the  variation  of 
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Fig.  26.  Time  history  of  the  torque  variation  of  the  six  engines 


Fig.  27.  Simulink  file  for  the  implementation  of  LQR  controller 

the  angular  speed  of  the  other  body  axes.  In  that  case,  all  the  variables  are  controlled  so  they  asymptotically  converge 
to  a  reference  value,  that  is  different  from  zero.  All  the  time  histories  are  in  Fig.  42.  The  blue  line  are  the  virtual  inputs 
Vi  obtained  by  the  application  of  the  experimental  inputs  with  an  jCi  adaptive  controller. 
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Fig.  28.  Simulink  file  for  the  implementation  of  jCi  controller 


Fig.  29.  Time  histories  of  the  virtual  inputs  for  the  ideal  case 
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Fig.  30.  Closed  loop  time  histories  of  the  virtual  input  Vi  for  both  controllers 
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Fig.  31.  Closed  loop  time  histories  of  the  virtual  input  V2  for  both  controllers 
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Fig.  32.  Closed  loop  time  histories  of  the  virtual  input  for  both  controllers 


Fig.  33.  Closed  loop  time  histories  of  the  virtual  input  for  both  controllers 
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Fig.  34.  Time  histories  of  the  jCi  controlled  inputs  for  the  ideal  case 


Fig.  35.  Time  histories  of  the  virtual  inputs 
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Fig.  36.  Closed  loop  time  histories  of  the  virtual  input  vi  for  both  controllers  -  Experimental  inputs 


Fig.  37.  Closed  loop  time  histories  of  the  virtual  input  V2  for  both  controllers  -  Experimental  inputs 
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Fig.  38.  Closed  loop  time  histories  of  the  virtual  input  for  both  controllers  -  Experimental  inputs 


Fig.  39.  Closed  loop  time  histories  of  the  virtual  input  for  both  controllers  -  Experimental  inputs 
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Fig.  40.  Closed  loop  time  histories  of  the  virtual  inputs  u,  with  time  delay 
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Fig.  41.  Closed  loop  time  histories  of  the  virtual  inputs  u,  with  time  delay  -  Experimental  inputs 
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Fig.  42.  Closed  loop  time  histories  of  the  nonlinear  model  with  time  delay 
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Fig.  43.  Time  histories  of  the  Ci  controlled  inputs  for  the  experimental  case 
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8.  CORRELATIONS  OF  SIMULATIONS  AND  REAL  FLIGHT  CONDITIONS 

The  VICON  system  is  connected  to  the  PC  with  a  protocol  called  TCP/IP  and  with  the  same  protocol  it  communicates 
with  a  Matlab-Simulink  model.  The  PixHawk  autopilot  and  the  remote  controller  (for  manual  piloting)  is  connected  to 
the  computer  with  a  UDP  protocol.  UDP  is  used  as  a  way  for  applications  to  communicate  using  a  small  set  of  protocol 
mechanisms.  It  does  not  guarantee  delivery  or  packet  order  as  the  Transmission  Control  Protocol  (TCP)  does.  UDP 
requires  the  Internet  Protocol  (IP)  to  be  used  as  the  underlying  protocol. 

Figure  44  shows  the  basic  setup  for  a  closed  loop  control  experiment  in  the  Spacecraft  Robotics  Laboratory.  The  Vicon 
system  tracks  the  position  of  the  markers  on  the  hexacopter  body  and  the  Vicon  tracker  software  computes  its  the 
position  and  orientation.  A  Mat  lab  script  reads,  from  a  TCT/IP  port,  the  position  and  orientation  of  the  object  and 
send  these  values  through  UDP  port  to  the  Simulink  environment  of  a  different  Matlab  section  in  the  same  computer. 
The  RF  transmitter  DX7  has  the  property  to  operate  in  the  slave  mode,  which  means  that  two  transmiters  can  be 
connected  through  an  audio  cord  and  commands  from  the  slave,  under  PPM  protocol,  can  be  transmitted  through  the 
master  device.  In  the  Simulink  environment,  the  input  to  the  hexacopter  is  converted  to  a  PPM  signal  and  sent  to  the 
audio  device.  So,  this  experimental  setup  is  closed  by  substituting  a  slave  transmitter  by  the  output  from  the  computer 
audio  card.  When  autonomous  flight  is  performed,  the  RF  transmitter  is  substituted  by  the  PixHawk  autopilot. 


SIMULINK 


Fig.  44.  Closed  loop  connections 

In  experimental  flights  we  verified  that  from  the  VICON  system  acquisition  and  the  data  sent  from  Matlab-Simulink 
enviroment  to  PixHawk  autopilot  a  delay  of  about  0.01  s  occur.  For  this  reason,  in  the  Section  7  a  time  delay  is 
considered  on  the  control  channel.  In  that  way  we  have  considered  a  ’’realistic”  case. 

9.  CONCLUSIONS 

The  objective  of  this  research  (FOARD  Grant  14  —  5007)  is  a  feasibility  study  of  an  jCi  adaptive  controller  for  rendez¬ 
vous  and  docking  maneuvers,  including  theoretical  background  and  a  comprehensive  analysis  of  simulation  results. 
A  model-based  design  of  the  system  is  considered  to  reduce  development  time  and  cost  by  eliminating  the  need  for 
early  product  prototypes.  The  model-based  design  of  a  multi-rotor  UAV  started  from  the  identification  of  the  model 
parameters  and  included  and  exploration  of  position  estimation  techniques  using  a  VICON  system.  The  multi-rotor 
UAV  is  used  as  prototype  for  technology  demonstration. 

The  nonlinear  and  linear  models  of  an  hexarotor  Unmanned  Aerial  Vehicle  (UAV)  are  identified  using  a  VICON  system. 
The  VICON  system  is  considered  for  measuring  the  moments  of  inertia  and  for  evaluating  the  static  gains  of  the  engine 
(both  thrust  and  torque  gains).  This  approach  is  chosen  for  reducing  the  time  of  collecting  data  and  to  avoid  the  risk 
of  accidents  during  flight  tests,  considering  that  a  stable  and  robust  controller  is  not  yet  implemented  on-board  and  it 
is  the  scope  of  this  research.  Some  simulations  are  performed  to  validate  the  implementation  of  the  nonlinear  model  in 
the  Matlab-Simulink  environment. 

Two  controllers  have  been  implemented:  (i)  a  classical  linear  quadratic  regulator  (LQR)  and  (ii)  an  jCi  adaptive 
controller.  Both  controller  performance  are  validated  by  simulations.  Different  cases  are  analyzed,  including  simulations 
of  experimental  flights.  The  £i  adaptive  controller  is  validated  not  only  for  the  linear  model  but  also  for  the  nonlinear 
model  and  for  ’’realistic”  cases  in  which  a  time  dealy  and  an  actuator  model  are  included.  Both  controllers  guarantee 
good  performance.  A  retuning  of  the  Ci  controller  is  not  required  even  in  presence  of  time  delay  and  for  the  nonlinear 
model.  The  main  contribution  of  this  research  is  to  demonstrate  that  the  proposed  control  design  can  stabilize  the 
nonlinear  system,  even  if  the  controller  parameters  are  selected  starting  from  a  simplified  linear  model.  The  main 
advantages  of  this  technique  are:  (i)  the  controller  can  be  implemented  for  both  linear  and  nonlinear  systems  without 
parameter  adjustment  or  tuning  procedure,  (ii)  the  controller  is  robust  to  unmodelled  dynamics  and  parametric  model 
uncertainties.  Moreover,  the  jCi  adaptive  controller  is  able  to  reduce  the  measurement  noise,  due  to  the  low  pass  filter 
in  the  control  law.  This  filter  can  be  useful  for  improving  the  data  acquisition  of  the  accelerometers  and  for  flight  tests 
combined  with  a  Kalman  filter  (to  have  less  noisy  results). 

This  feasibility  study  demonstrates  also  that  the  jCi  adaptive  controller  has  good  performance  for  fast  dynamics  channel 
but  it  needs  to  be  connected  to  a  second  control  channel  for  the  slow  dynamics  of  the  system,  i.e.  speed  and  altitude 
variations.  As  in  [8]  navigation  outer  loop  parameters  are  regulated  via  BID  algorithms.  One  limitation  of  this  controller 
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is  that  the  linear  model  has  to  be  known.  For  this  reason  we  needed  to  identify  the  linear  model  of  the  hexacopter. 
This  is  a  limitation  because  it  is  a  time  comsuming  process  and  it  is  a  simplified  model  of  the  highly  nonlinear 
real  system.  For  future  development  a  sliding  mode  controller  based  on  the  nonlinear  model  will  be  considered.  The 
sliding  mode  controller  must  guarantee  that  the  system  trajectories  reach  and  maintain  a  motion  on  the  desired  sliding 
manifold.  Moreover,  sliding  mode  control  can  provide  global  stability  and  ensure  insensitivity  and  robustness  to  system 
uncertainties  and  external  disturbances.  In  particular,  the  sliding  mode  ability  to  reject  disturbances  and  parameter 
variations  is  useful  for  space  applications.  Thus,  this  controller  could  be  implemented  for  the  Chaser  position  tracking 
during  the  approaching  maneuver  to  a  passive  vehicle  (Target). 
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10.  NOTE:  DIFFERENCES  BETWEEN  THE  DEVELOPED  AND  THE  ORIGINAL  PROJECT 

The  original  project  should  considered  the  following  points: 

(1)  Implementation  of  the  model  of  a  multi-rotor  UAV 

(2)  Development  of  an  £i -based  GNC 

(3)  Development  of  a  robust  control  with  time  varying  parameters 

(4)  Comprehensive  analysis  of  simulation  results 

The  first  two  points  and  the  last  point  are  deeply  discussed  in  the  report  and  both  a  linear  and  nonlinear  system  is 
considered.  An  £i  adaptive  controller  is  implemented  in  Matlab-Simulink.  A  real  platform  is  considered  in  the  overall 
project  and  the  connection  with  a  PixHawk  autopilot  (that  is  the  autopilot  installed  on  board)  is  performed,  in  order 
to  perform  real  time  simulations  (connection  with  UDP,  discussed  in  Section  8). 

For  the  other  points,  we  can  imagine  to  have  matching  time  varying  parameters  and  a  target  fixed  on  ground.  A  classical 
linear  quadratic  regulator  (LQR)  is  implemented  and  compared  with  the  adaptive  controller.  A  collaborative  and  fixed 
on  ground  target  is  considered.  This  is  not  a  limitation  on  the  proposed  research  due  to  that,  for  the  most  of  the 
literature  studies,  the  target  spacecraft  does  not  maneuver  by  firing  thrusters  during  the  rendez-vous  and  is  moving  in 
a  predefined  elliptical  orbit. 

Due  to  time  constraints,  only  some  points  are  deeply  discussed  and  implemented.  The  original  idea  was  to  use  only 
a  linear  system  for  the  simulation  results.  In  literature  is  possible  to  find  simple  linear  model  that  only  marginally 
describes  the  real  system.  For  the  implementation  of  an  Ci  adaptive  controller  and  to  avoid  singularity  in  the  controller, 
a  detailed  model  is  usually  considered.  For  this  reason,  a  detailed  identification  of  the  multirotor  system  is  considered 
and  proposed  in  this  project  to  improve  the  dynamic  characteristics. 

A  comprehensive  analysis  of  different  cases  is  deeply  presented  in  the  Section  7.  The  nonlinear  model  with  time  delay 
and  actuator  model  (that  is  a  model  similar  to  the  real  platform)  is  also  considered  and  the  jCi  controller  performance 
are  validated  also  for  this  case. 

The  only  point  that  it  is  not  considered  is  the  implementation  of  a  guidance  algorithm  for  the  docking  of  a  fixed  point. 
The  idea  is  to  implement  a  guidance  algorithm  that  is  based  on  some  simplifying  hypothesis,  according  to  the  flash 
memory  limitation  of  the  autopilot  microcontroller.  A  given  set  of  waypoints  will  be  considered,  with  assigned  North, 
East  and  altitude  coordinates.  Some  implementation  aspects  common  to  other  algorithms  available  from  literature  are 
also  considered: 

•  the  trajectory  smoother,  that  makes  cinematically  feasible  the  assigned  trajectory  in  terms  of  speed  and  turn  rate 
constraints, 

•  the  cross-track  error  control,  to  monitor  the  UAV  position  with  respect  to  the  reference  path. 

•  Look-ahead  or  proximity  distance,  to  define  the  minimum  distance  of  the  UAV  from  the  next  waypoint  to  begin 
turning.  When  the  distance  between  the  aircraft  and  the  next  waypoint  is  less  than  this  distance,  the  waypoint  is 
reached  and  the  aircraft  can  move  to  the  next  waypoint. 

We  had  no  time  to  implement  the  guidance  algorithm  and  validate  it  by  simulation  results. 
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